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© Method of computing drive pattern for suppressing vibration of industrial robot. 



® Vibration occurring at an arm part of an industrial 
robot when the arm part is moved is controlled by 
combining vibrations occurring at. two time points for 
mutual interference. In each of acceleration and 
slowdown periods, the time difference of rise and fall 
time points ti , U and t 2 , t 3 of a differential value of 
an acceleration with respect to time is set to be an 



integral number times the natural vibration period of 
the system so that the vibrations occurring at the 
rise and fall time points interfere with each other to 
cancel one another. Also, the vibration occurring in 
the acceleration period and the vibration occurring in 
the slowdown period can cancel each other. . 
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BACKGROUND OF THE INVENTION 

1. Field of the Invention: • 

* This invention relates to a method for sup- 
pressing vibration of an object driven by a driving 
force, and more particularly to a method of control- 
ling . an industrial robot by suppressing vibration 
while a robot arm is running and when the robot 
arm is positioned in a stop position. 

2. Description of the Prior Art: 

In recent years, in order to reduce the work 
load on workers in rriodern manufacturing plants, 
application of industrial robots has been on the 
increase. FIG. 1 of the accompanying drawings 
shows a conventional • industrial robot of a biaxial 
control type in which the robot can rotate and can 
move vertically. As shown in FIG. 1, a finger por- 
tion 5 for gripping a workpiece is mounted on the i 
distal end of a robot arm 4, which is driven by a 
servo motor 3 for rotational motion and a raising 
and lowering motion. The servo motor 3 is driven 
from a controller 1 via a servo amplifier 2. 

If the above-mentioned robot is accelerated at 
appoint a in FIG. 1 from a rest state, to a predeter- 
mined speed and is then slowed down to assume a 
rest state at a point b, vibration would occur, par- 
ticularly at points where acceleration varies largely, 
which might cause an error in controlling the robot 
so that it is necessary to wait for the next action 
until the vibration comes to an end. On many 
occasions, the points where this vibration occurs is 
start and end points of each of acceleration and 
slowdown. The vibration occurring during accelerat- 
ing remains at the time of constant speed motion, 
which might cause an error in positioning the finger 
portion 5. The vibration at the time of constant 
speed motion would be a cause for nonuniform 

• coating in, for example, coating work. In the pres- 
ence of the vibration occurring during slowdown, 
after coming to rest, the robot has to wait for work 
such as assembling work, until the vibration comes 
to an end, thus resulting in a waste of time. 

Studies have been made to suppress vibration 
of the robot; to this . end, it is currently known to 
control vibration as disclosed in, for example, Japa- 
nese Patent Laid-Open Publications Nos. SHO 63- 
314606 and 63-314607. According to this appara- 
tus, the vibration occurring at the distal end of a 
robot arm is detected by an acceleration sensor 
mounted on the robot arm end and this detection 
signal is back as a turbulent torque, thus adjusting 
the driving force to the occurred vibration. 

In this prior art, however, damping control 
takes place after vibration has. actually occurred so 
- that, although . the time from the occurrence of 



vibration to the end can be reduced, vibration can- 
not be eliminated. In other words, since control 
information to bring vibration to an end is obtained 
from the status of actual vibration, damping control 

5 . cannot be performed until after vibration has oc- 
curred. It is therefore theoretically impossible to 
perfectly control viBration. Further, since vibration 
is damped following vibration of a relatively short 
period, this prior art control system requires a. 

w central processing unit (CPU) which enables high- 
speed computing. Accordingly the resultant control 
system is expensive and complicated. 
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In view of the foregoing problems, it is an 
object of this invention to suppress vibration of a 
moving part, such as an arm, of an industrial robot 
without counting on feedback control. 
20 A specific object of the invention is to provide 

a method of and apparatus for computing a drive 
pattern which can suppress vibration of a moving 
part, such as an arm, of an industrial robot and can 
give a damping effect. Another specific object of 
25 the invention is to provide a method of controlling 
an industrial robot according to the computed drive 
pattern. 

According to a first aspect of the invention, 
there is provided a method of computing a drive 
30 pattern for suppressing vibration of a moving part, 
comprising the steps of: (a) obtaining a driving 
pattern of the moving part, which pattern includes 
an acceleration period, a constant speed period 
and a slowdown period; (b) calculating a differentia! 
35 value of acceleration with respect to time of the 
moving part, from the drive pattern; (c) calculating 
a time difference between a rise portion and a fall 
portion of the differential value of the acceleration 
time; and (d) correcting the drive pattern in such a 
46 manner that the time difference changes substan- 
tially by an integral number times a natural vibra- 
tion period of the moving part. 

The drive pattern correcting step may com- 
prise fixing the duration of the acceleration and/or 
45 slowdown period, setting, in the fixed duration of 
the acceleration and/or slowdown period, an accel- 
eration constant increase period in which accelera- 
tion increases at a constant rate with respect to 
time and an acceleration constant decrease period 
so in which acceleration decreases at a constant rate 
' with respect to time, and correcting the duration of 
each of the acceleration constant increase period 
and acceleration constant decrease period. 

The drive pattern correcting step may be the 
55 step c-f correcting the duration of the acceleration 
or slowdown period, so as to be equal to the 
natural vibration period of the moving part, under 
the condition that acceleration is constant in the 
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acceleration or slowdown period! 

With these drive patterns, the moving part of 
the industrial robot is caused to start vibrating at its 
natural frequency at rise and fall portions of the 
differential value of acceleration with respect to 
time of the moving part. At the rise and fair por- 
tions, since the directions of applying the respec- 
tive vibrations are opposite to each, other, the vibra- 
tion occurring at the rise portion is canceled by the 
vibration occurring at the fall portion. 

Further, if the acceleration and slowdown 
periods include an acceleration constant increase 
period in which acceleration increases at a constant 
rate, an acceleration constant decrease period in 
which acceleration decreases at a constant rate 
and a constant acceleration period in which accel- 
eration is constant, the start point of each of the 
acceleration constant increase period and the ac- 
celeration constant decrease period is the time 
point in which vibration is exerted on the moving 
part, thus facilitating calculation of the vibration 
applying time difference. 

Furthermore, without changing the duration of 
the acceleration and slowdown periods, it is possi- 
ble to correct the vibration applying time difference 
by changing the duration of the acceleration con- 
stant decrease period and/or the acceleration con- 
stant increase period. It is therefore possible to 
suppress vibration without extending the accelera- 
tion period and/or slowdown period so that the 
work time is not long. 

According to a second aspect of the invention, 
there is provided a method of computing a drive 
pattern for suppressing vibration of a moving part, 
comprising the steps of: (a) obtaining a driving 
pattern of the moving part, which pattern includes 
an acceleration period, a constant speed period 
and a slowdown period; and (b) judging, by com- 
paring the duration of each of the acceleration . 
period and slowdown period of the drive pattern 
with the natural vibration period of the moving part, 
as to whether the duration of each of the accelera- 
tion period and slowdown period of the drive pat- 
tern is longer or shorter than the natural vibration 
period; (c) the method, if the acceleration or 
slowdown period is longer than the natural vibration 
period, further including: (1) calculating a differen- 
tial value of acceleration with respect to time of the 
moving part, from the drive. pattern; (2) calculating 
a time difference between a rise portion and a fall 
portion of the differential value of the acceleration 
time; and (3) correcting the drive pattern, in such a 
manner that the time difference changes substan- 
tially by an integral number times a natural vibra- 
tion period of the moving part, by fixing the dura-: 
tion of the "acceleration arid/or slowdown period, 
setting, in the fixed duration of the acceleration . 
and/or slowdown period, an acceleration constant 



increase period in which acceleration increases at a 
constant rate with respect to time and an accelera- 
tion constant decrease period in which acceleration 
decreases at a constant rate with respect to time, 
5 and correcting the duration of each of the accelera- 
tion constant increase period and acceleration con- 
stant decrease period; (d) the method, if the accel-. 
eration . or slowdown period is shorter than the 
natural vibration period, further including the step 

w of (4) correcting the duration of the acceleration or 
slowdown period, so as to be equal to the natural 
vibration period of the moving part, under the con- 
dition that acceleration is constant in the accelera- 
tion or slowdown period. 

75 • Using this drive pattern computing. method, it is 
possible to suppress vibration by two vibrations 
occurring with a time lag, even if the duration of the 
acceleration or slowdown period is shorter than the 
natural vibration period of the moving part. 

20 According to a third aspect of the invention, 

there is provided a method of computing a drive 
pattern for suppressing vibration of a. moving part 
of an industrial robot, comprising: (a) obtaining a 
drive pattern of the moving part; (b) calculating a 

25 time difference of torque peaks in the acceleration 
and slowdown periods of the drive pattern; and (c) 
judging, by ^comparing the time difference with the 
natural vibration period of the moving part, as to 
whether the time difference is longer or shorter 

30 than the natural vibration period; (d) the method/ if 
the time difference is shorter than the natural vibra- 
tion period, further including: (1) correcting the 
drive pattern in such a manner that the time dif- 
ference of the torque peaks substantially coincides 

35 with the natural vibration period; (e) the method, if 
the time difference is longer than the natural vibra- 
tion period, further including the steps of: (2) cal- 
culating a time duration of each of the acceleration 
and slowdown periods of the drive pattern; and (3) 

40 judging, by comparing the duration of each of. the 
acceleration and slowdown periods of . the drive 
pattern with the natural vibration period, as to 
whether the duration of the acceleration and 
slowdown periods is longer or shorter than the 

45 . natural vibration period; (f) the method, if the dura- 
tion of the acceleration or slowdown period is long- 
' er than the natural vibration period, further includ- 
ing the steps .of: (4) calculating a differential value 
. of acceleration with respect to time of the moving 

so part from the drive pattern; (5) calculating a time 
difference of rise and fall portions of the differential 
value of acceleration with respect to time; and (6) 
correcting the drive pattern, in such a manner that 
the time difference changes by an integral number 

55 times the natural vibration period, by fixing the 
duration of the acceleration or slowdown period 
and setting an acceleration constant increase pe- 
riod in which acceleration increases with time at a 
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constant rate in the last-named period and an ac- 
celeration constant decrease period, in which ac- 
celeration decreases with time at a constant rate; 
(g) the method, if the acceleration or slowdown 
period is shorter than the natural vibration period, 
further including the step of (7) correcting the drive 
pattern, in such a manner that the duration of the 
acceleration or slowdown period coincides with the 
natural vibration period, under the . condition that 
acceleration is constant in the acceleration or 
slowdown period. 

By this drive pattern computing method, it is 
possible to . suppress vibration of a moving part, 
irrespective of whether the time difference of 
torque peaks of each of the acceleration . and 
slowdown periods is longer or shorter than the 
natural vibration period of the moving part. It is also 
.possible to suppress vibration of a moving part, 
irrespective of whether the acceleration or 
slowdown period is longer or shorter thanr the natu- 
ral vibration period. 

According to a fourth aspect of the invention, 
there is provided a method of controlling a moving 
part of an industrial robot, wherein the moving part 
is driven and controlled in a predetermined drive 
pattern in which a time difference of rise and fall 
portions of a differential value of acceleration with 
respect to time of the moving part is substantially 
. an integral number times a natural vibration period 
of the moving part. 

Further, the drive pattern may include an accel- 
eration period in which the moving part is to be 
accelerated and a slowdown period in which the 
moving part is to be slowed down, and the accel- 
eration and slowdown periods may include an ac- 
: celeration constant increase period in which accel- 
eration increases with time at a constant rate in the 
last-named periods and an acceleration constant 
decrease period in which acceleration decreases 
with time at a constant rate. 

By each of these industrial robot control meth- 
ods, it is possible to suppress occurrence of vibra- 
tion as two vibrations occurring with a time dif- 
ference between them are canceled by each other. 

According to a fifth aspect- of the invention, 
there is provided an apparatus for computing a 
drive pattern for suppressing vibration of a moving 
part of an industrial robot, comprising: (a) means 
for obtaining a drive pattern of the moving pattern, 
which pattern includes an acceleration period, a 
constant speed period . and a slowdown period; (b) 
means for calculating a differential value of accel- 
eration with respect to time of the moving part from 
the drive pattern; (c) means for calculating a time 
difference of rise and fall portions of the accelera- 
tion time differential value; and (d) means for cor- 
recting the drive pattern in such a manner that the 
time difference is substantially an integral number 



times a natural vibration period of the moving part. 

Further, the drive pattern correcting means 
comprises means for fixing the duration of the 
acceleration and/or slowdown period, means for 
5 setting, in the fixed duration of the acceleration 
and/or slowdown period, an acceleration constant 
increase period in which acceleration increases at a 
constant rate with respect to time and an accelera- 
tion constant decrease period in which acceleration 
70 decreases at a constant rate with respect to time, 
and means for correcting the duration of each of 
the acceleration constant change period and the 
acceleration constant decrease period. 

According to a sixth aspect of the invention, 
75 there is provided an apparatus for computing a 
drive pattern for suppressing vibration of a moving 
part, comprising: (a) means for obtaining a driving 
pattern of the moving part which pattern includes 
an acceleration period, a constant speed , period 
20 and a slowdown period; and (b) means for judging, 
by comparing the duration of each of the accelera- 
tion period and slowdown period of the drive pat- 
tern with the natural vibration period Of the moving 
part, as to whether the duration of each of the 
25 acceleration period and slowdown period of the 
drive pattern is longer or shorter than the natural 
vibration period; (c) the apparatus, if the accelera- 
tion or slowdown period is longer than the natural 
vibration period, further including: (1) means for 
30 calculating a differential value of acceleration with 
respect to time of the moving part from the drive 
pattern; (2) means for calculating a time. difference 
between a rise portion and a fall portion of the 
differential value of the acceleration time; and (3) 
35 means for correcting the drive pattern, in such a 
. manner that the time difference changes substan- 
tially by an integral number times a natural vibra- 
tion period of the moving part, by fixing the dura- 
tion of the acceleration and/or slowdown period, 
40 setting, in the fixed duration of the acceleration 
and/or slowdown period, an acceleration constant 
increase period in which acceleration increases at a 
constant rate with respect to time and an accelera- 
tion constant decrease period in which acceleration 
45 decreases at a constant rate with respect to time, 
and correcting the duration of each of the accelera- 
tion constant increase period and acceleration con- 
stant decrease period; (d) the apparatus, if the 
acceleration or slowdown period is shorter than the 
50 natural vibration period, further including (4) means 
for correcting the duration of the acceleration or 
slowdown period, so as to be equal to the natural 
vibration period of the moving part, under the con- 
dition that acceleration is constant in the accelera- 
55 tion or slowdown period. 

According to a seventh aspect of the invention, 
there is provided an apparatus for computing a 
drive pattern for suppressing vibration of a moving 
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part of an industrial robot, comprising: (a) means 
for obtaining a drive pattern of the moving part; (b) 
means for calculating a time difference of torque 
peaks in the acceleration and slowdown periods of 
the drive pattern; and (c) means for judging, by 5 
comparing the time difference with the natural vi- 
bration period of the moving part, as to whether the 
time difference, is longer or shorter than the natural 
vibration period; (d) the apparatus, if. the time dif- 
ference is shorter than the natural vibration period, w 
further including: (1). means for correcting the drive 
pattern in such a manner that the time difference of 
the torque peaks substantially coincides with the 
natural vibration period; (e) the apparatus, if the 
time difference is longer than the natural vibration 75 
period, further including: (2) means for calculating a 
time duration of each of the acceleration and 
slowdown periods of the drive pattern; and (3) 
means for judging, by comparing the duration of 
each of the acceleration and slowdown periods of 20 
the drive pattern with the natural vibration period, 
as to whether the duration of the acceleration and 
slowdown periods is longer or shorter than the 
natural vibration period; (f) the apparatus, if the 
duration of the acceleration or slowdown period is 25 
longer than the natural vibration period, further in- 
cluding:^) means for calculating a differential val- 
ue of acceleration with respect to time of the. mov- 
ing part from the drive pattern; (5) means for cal- 
culating a time difference of rise and fall portions of 30 
the acceleration time differential value; and (6) 
means for correcting the drive pattern, in such a 
manner that the time difference changes by an 
integral number times the natural vibration period, 
by fixing the duration of the acceleration or 35 
slowdown period and setting an acceleration con- 
stant increase period in which acceleration in- 
creases with time at a constant rate in the last- 
named period and an acceleration constant de- 
crease time in which acceleration decreases with 40 
time at a constant rate; (g) the apparatus, if the 
acceleration or slowdown period is shorter than the 
natural vibration period, further including (7) means . 
for correcting the drive pattern', in such manner that 
the duration of the acceleration or slowdown period 45 
coincides with the natural vibration period, under 
the condition that acceleration . is constant in the 
acceleration or slowdown period. 

By each of the foregoing methods, it is possi- 
ble to eliminate any vibration, which might remain 50 
after the moving part has been accelerated and 
slowed down, of ah industrial robot by combining 
two suitable vibrations which have occurred in the 
moving part and then setting such a condition that 
these two vibrations are inverted in phase with 55 
respect to each other. 

Further, the method of this invention can sup- 
press vibration without counting on feedback con- 



trol so that it is not necessary to use a feedback 
control sensor or to cope with the high-speed pro- 
cessing system. It is therefore possible to provide 
an inexpensive and simple control system. 

BRIEF DESCRIPTION OF THE DRAWINGS 

FIG. 1 is a diagram schematically showing a 
prior art apparatus; 

FIG. 2 is a diagram schematically showing an 
apparatus according to a first embodiment of 
this invention; 

FIG. 3 shows a speed instruction pattern of the 
apparatus of the first embodiment of FIG. 2; 
FIG. 4 is a block diagram showing a CPU of the 
embodiment of FIG. 2 in detail; 
FIG. 5 is a block diagram showing a drive pat- 
tern correcting section of the CPU of FIGS. 2 
and 4; 

FIG. 6 is a flowchart showing a control system 
of the apparatus according to the first embodi- 
ment; 

FIG. 7 shows a speed instruction, prior to vibra- 
tion suppressing control, and a vibration occur- 
ring due to the speed instruction in the appara- 
tus of the first embodiment; 
FIG. 8 shows another speed instruction, prior to 
vibration suppressing control, and another vibra- 
tion occurring due to the speed instruction in the 
apparatus of the first embodiment; 
FIG. 9 is a flowchart showing another control 
system according to a second embodiment of 
this invention; 

FIG. 10 shows a typical speed instruction pat- 
tern in which a robot arm end is accelerated and 
then quickly slowed down with no constant 
speed period, and an amplitude of the robot arm 
end at that time; 

FIG. 1 1 shows another typical speed instruction 
pattern in which the robot arm end is acceler- 
ated, then moved at a constant speed for a 
predetermined time and finally slowed down, 
and an amplitude of the robot arm end at that 
time; 

FIG. 12 illustrates a damping effect due to cor- 
recting the time difference of torque peaks oc- 
curring at the time of acceleration and slowdown 
in the second embodiment of FIG. 9; 
FIG. 13 illustrates another damping effect due to 
correcting the duration of each of the accelera- 
tion and slowdown periods in the second em- 
bodiment of FIG. 9; 

FIG: 14 is a block, diagram showing a CPU of 
the second embodiment- of FIG. 9 in detail; 
FIG. 15 is a graph showing an electric current 
applied to a servo motor and a vibration of the 
robot arm end in contact; and 
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FIG. 16 is a block diagram showing an equip- 
ment which detects the value of an electric 
' current applied to the servo motor arid performs 
a frequency analysis. 

DETAILED DESCRIPTION OF. THE PREFERRED 
EMBODIMENTS 

Preferred embodiments of this invention will 
now be described with reference to the accom- 
panying drawings. FIG. 2 shows an industrial robot 
apparatus according to this invention; elements or 
parts similar to those bf the prior art apparatus are 
designated by like reference numerals and their 
descriptions are omitted here. The apparatus is 
characterized in that a controller 1 comprises a 
central processing unit (CPU) 11 for performing a 
below-described arithmetic process, arid a memory 
12 for storing the arithmetic result. The robot of this 
apparatus, like the prior art robot, can make a 
turning motion as indicated by an arrow A and 
raising and lowering motions; In the following de- 
scription, however, only a single-dimensional mo- 
tion, e!g. the above-mentioned turning motion, is 
described, for ease of understanding. According to 
this invention, the same control can be applied not 
only to the illustrated example enabling a turning 
motion but also to an alternative example enabling 
a linear motion. . • 

FIG. 3 shows a drive pattern, for controlling a 
robot hand, according to this apparatus, and more 
particularly a speed instruction pattern and a speed 
time differential value at that time and a secondary 
time differential value. In the graph (a), the speed 
instruction value v for controlling the moving speed 
of a finger portion 5 is shown with respect to time t 
plotted on the x axis. In the graph (b), the primary 
differential value v (*) with respect to time of the 
speed instruction value v is shown, namely, accel- 
eration. In the graph (c), ( the secondary differential 
value v (■•') with respect to time of the speed 
instruction value v is shown. The secondary dif- 
ferential value y .("). of the graph (c) is the primary 
differential value with respect to time of the accel- 
eration v C) of the graph (b), representing the rate 
of change of acceleration. 

The speed instruction, as shown in FIG. 3, 
includes an acceleration period Pa in which the 
robot hand is accelerated from a rest state to a 
predetermined speed vt , a constant speed period 
P c in which the robot hand is moved at a predeter- 
mined speed vi, and a slowdown period P B in 
which the robot hand is slowed down from the 
predetermined speed Vn to a stopped state. This 
embodiment is characterized in that the accelera- 
tion period P A further includes an acceleration con- 
stant increase period P A i in which acceleration 
increases with respect to time by a constant rate, a 



constant acceleration period Pa2 in which accelera- 
tion is constant, and an acceleration constant de- 
crease period P A 3 in which acceleration decreases 
with respect to time by a constant rate. Likewise, 
5 the slowdown period P B includes an acceleration 
constant increase period P B i, a constant accelera- 
tion period P B2 and an acceleration constant de- 
crease period Pb3- 

When acceleration varies with respect to time . 
10 by a constant rate, the change of speed is repre- 
sented by a second order curve. When accelera- 
tion is constant with respect to time, the change of 
speed is represented by a straight line. Therefore, 
in the speed instruction value of FIG. 3(a), the 
15 acceleration period P A and slowdown period P B are 
represented by a shape in which two second order 
curves are connected by a straight line. 

If the robot hand is controlled in such a speed 
control pattern, a vibration causing force, which is a 
20 cause for vibration, acts on the robot hand at each 
of time points ti , V at which the primary differential 
value v ('*) of acceleration rises and at each of time 
points t2 , t3 at which the primary differential value v 
(•*) of acceleration falls. Since the vibrations occur- 
25 ring at the rise and fall portions are inverted in 
phase with respect to each other, the vibration 
occurring at the preceding time point is canceled 
by the vibration causing force occurring at the 
succeeding time point if the time difference 
30 (hereinafter called "the vibration causing time dif- 
ference") at the rise time point and the fall time 
point coincides with the natural vibration period of 
the robot hand. Specifically, in the acceleration 
period P A , the vibration of the natural vibration 
35 period occurring at the time point ti, in which the 
primary differential value v O of acceleration rises, 
interferes with the vibration occurring at the time 
point t 2 , to suppress vibration. Accordingly, as the 
vibration causing time difference T 5 from the rise 
40 time point ti to the fall time point t 2 is an integral 
number times the natural vibration period, two vi- 
brations inverted in phase. interfere with and cancel 
each other. Likewise, in the slowdown period P B , as 
the vibration causing time difference of the rise and 
45 fall time points t 3 , U is an integral number times 
the natural vibration period, the two vibrations oc- 
curring at the "two time points ta, U can interfere 
with and cancel each other. Therefore, after the 
constant speed period P c and the stopping, it is 
50 possible to suppress vibration of the finger portion 
5 of the robot arm. 

FIG. 4 shows the CPU 11 of the first embodi- 
ment in detail. According to a control program for 
controlling the arm of the industrial robot, a drive 
55 pattern is calculated in a drive pattern calculating 
section 111. In this embodiment, the drive pattern 
at this time point is a drive pattern composed of a 
constant acceleration motion and a constant speed 
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motion. In an acceleration differential value cal- 
culating section 112, a differential value v (") of 
acceleration with respect to time is calculated so 
that the rise and fall portions are calculated. At the 
time point at which this differential value v (") 
varies sharply, vibration occurs. Further, the time 
differences Ti, T 2 of the rise and fall portions are 
calculated in a time difference calculating section 
113. Based on this time difference, the drive pat- 
tern is corrected in a drive pattern, correcting sec- 
tion 114. 

FIG. 5 . shows the drive pattern, correcting sec- 
tion 11 4 of the CPU 11 of this embodiment in 
detail. In a period duration fixing section 114a, the 
duration of each of the acceleration and slowdown 
periodis P A , Pb calculated in the drive pattern cal- 
culating section 111 is fixed. Each of the accelera- 
tion and: slowdown, periods P A , P B includes an 
acceleration constant increase period P A i, Pbi in 
which acceleration increases by a constant rate, an 
^acceleration constant decrease period P A3 , P B3 in 
which acceleration decreases by a constant rate, 
and a constant acceleration period P A 2. Pb2 in 
which acceleration is constant. The periods P A1 , 
Pbi» Pa3. Pb3. Pa2» Pb2 are set in setting sections 
114b, 114c. Finally, the duration of each of the 
acceleration and slowdown periods P A , P B is set in 
such a . manner that the time differences T s , T6 
between the start time points ti , t4 of the accelera- 
tion constant increase periods and the start time 
points b, t3 of the acceleration constant decrease 
periods coincide with an integral number times the 
.natural vibration period of the robot arm, thus cor- 
recting the. drive pattern. 

FIG. 6 is a flowchart showing the control of this 
embodiment. Steps S1, S2 are set previously. In 
Step S1; a natural vibration frequency f of a system 
including a movable part, such as. an arm 4 and a 
finger portion 5, of the industrial robot is measured. 
Based on the natural vibration frequency f, a natu- 
ral vibration period X as a free vibration period of 
the system is calculated. The natural vibration pe- 
riod X can be calculated as a reciprocal number of 
the natural vibration frequency f . 

In the actual operation, the natural vibration 
frequency f varies according to the position and 
posture of the robot arm 4 as well as the load due 
to the weight of a workpiece gripped by the finger 
portion 5. Consequently, the natural vibration fre- 
quency is measured, according to need, under a 
number of conditions for each of the position, the 
posture and the load. In the case of the robot arm 
4 of FIG. 2, since the natural vibration frequency, 
does not vary largely depending on the turning 
position, it is necessary to measure the natural 
vibration frequency in a typical vertical position. In 
the case of the robot hand which moves straightly 
on a canti levered support bar, since the rigidity of 



the system presumably varies largely depending 
oh the position, it is necessary to measure the 
natural vibration frequency at at least two points 
near the start and end points of movement of the 
s system. This frequency measuring is carried put by 
actually driving the robot arm 4 and detecting, the 
output of an acceleration sensor mounted on the 
robot arm 4 near its distal end. Alternatively it may 
be obtained by measuring the motion of the distal 

io end of the robot arm 4 by an optical measuring 
device. The thus measured natural vibration fre- 
quency of the system is then stored in the memory 
12 via the CPU 11 of the controller 1 of FIG. 2. 
Then in step S2, the CPU 1 1 computes the 

75 natural vibration period by recalling from the mem- 
ory 12 the stored natural vibration frequency. Since 
the period is the reciprocal number of the vibration 
frequency, it is calculated and is then stored again 
in the memory 12. 

20 "The manner in which natural vibration frequen- 
cies fi , f 2 are measured at the start and end points 
of a motion of the robot, and the manner in which 
natural vibration periods Xi , X 2 are calculated 
based on the measured frequencies f 1 , f 2 , will now 

25 be described. 

In step S3 "and subsequent steps, conditions 
are set as the control pattern for actually operating 
the robot arm. In step S3, a speed pattern, at the 
time of acceleration and slowdown, is set such that 

30 the . second order curve portions (P A i, P A3 ) are 
removed. In step S4, the speed pattern is cal- 
culated under this set condition. Accordingly, only 
the straight speed pattern devoid of second order 
. curves in the acceleration and slowdown periods is 

35 calculated, and as a result, the speed pattern from 
the operation start point to the operation stop point . 
assumes a trapezoidal shape. Namely, a pattern in 
which the robot arm is accelerated at a constant 
acceleration from a rest state to a predetermined 

40 speed, and is then slowed down at a constant 
acceleration from the predetermined speed to a 
rest state,, is set! In this case, the acceleration start 
time point, the acceleration end time point, the 
slowdown start time point and the slowdown end 

45 time point are vibration occurrence time points. 
The speed instruction value v and its primary and 
secondary differential values v ("), v (**) are shown . 
in FIG. 4. 

In the next step S5, the vibration causing time 
so differences Ti, T 2 of the acceleration and 
slowdown periods P A , P B are calculated based on 
the obtained speed pattern. In the acceleration and 
slowdown periods P A , P B , since acceleration is 
constant all times, the rise and fall of the differen- 
55 tial value of the acceleration occur at the start and 
end time points of the periods. Therefore, the vi- 
bration causing time differences Ti., T 2 become 
equal to the duration of the acceleration period P A 
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and the duration of the slowdown period P B , re- 
spectively. 

Then in step S6, the surplus of the calculated 
duration T r , T 2 of each of the acceleration and 
slowdown periods is calculated by each of the 
natural vibration periods Xi, X 2 at the respective 
points. Namely, since the acceleration period exists 
near the operation start point, the surplus of the 
acceleration period is calculated by the natural 
vibration period Xi. Since, the slowdown period 
exists near the operation end point, the surplus of 
the . slowdown period is calculated by the natural 
vibration period X 2 . This calculation is expressed 
by the following equations: 

T1/X1 = n with surplus T a (1) 
T2/X2 = n with surplus T b (2) 

In step S7, selection is made as to whether or 
not vibration should be suppressed during accel- 
eration. In the constant speed period P c , no work 
takes place, and only the finger portion 5 is moved. 
Also, if the vibration occurring during acceleration 
attenuates, to exert an influence in the slowdown 
period, no problem would arise even when vibration 
occurs during acceleration. In such an event, there- 
fore, it is not necessary to suppress vibration. Then 
the procedure goes to step S10. On the other 
hand, if any work takes place in the constant speed 
period P c , it is necessary to suppress the vibration 
which might occur during acceleration. Also, if the 
constant speed period P c is relatively short and the 
vibration occurring during acceleration remains dur- 
ing slowdown, to exert influence, it is necessary to 
suppress the vibration. 

If it is necessary to suppress vibration, the 
procedure goes to step S8, in which judgment is 
made as to whether the surplus T a is substantially 
equal to 0 or substantially equal to the natural 
vibration period X1 . In other words, judgment is 
. made as to whether or not the duration of the 
acceleration period P A is substantially an integral 
number times the natural vibration period Xi. If the 
surplus T a is judged to substantially equal 0 or 
substantially equal Xi, the vibrations occurring in 
the start and epd points in the acceleration period 
cancel each other, so that it is not necessary to 
change the speed pattern. In this case, the proce- 
dure goes to step S10. If the foregoing conditions 
are not satisfied, since the vibration occurring in 
.. the acceleration period remains in a succeeding 
period, to exert an influence, it is necessary to 
change the speed pattern so as to suppress vibra- 
tion. In this case,. procedure goes to step S9, in 
which correction is made to the. speed pattern 
including the second order curve of the graph (a) of 
FIG. 3. Correction is made to the spee.d pattern in 
such a manner that the vibration causing time 



difference T 5 of the . rise and fall of the acceleration 
differential value y (") shown in the graph (c) of 
FIG. 3 is an integral number times thei natural 
vibration period Xi (T 5 = nXi). Namely, as set in 
5 step S3, the rate of the second order curve to the 
acceleration period is changed to 0%. The rate a a 
is expressed by the following equation wherein T1 
is the duration of the acceleration period and T a is 
the surplus in the equation (1). 

10 

a a =Ta/Ti (3) 

The duration of each of the acceleration constant 
increase period P A i and acceleration constant de- 

15 crease period P A3 is : defined as T a , and the speed 
pattern is calculated in such a manner that the 
second order curve of these periods and the 
straight portion of the constant acceleration period 
Pa2 are smoothly connected together: Upon ter- 

20 mination of this calculating, procedure goes to step 
S10. 

In step S10, judgment is made as to whether 
or not is necessary to suppress vibration during 
slowdown. Similarly to the vibration suppression 
25 during acceleration, if there is no influence on the 
succeeding control, no correction is made to the 
speed pattern. For example, if no work takes place 
while the robot arm is stopped, no problem arises if 
vibration remains, and therefore it is not necessary 
30 to correct the speed pattern. If judgment is made 
that no correction is necessary, the procedure goes 
to step Si 3. On the other hand, if it is necessary to 
suppress vibration in, for example, fastening bolts 
at the stop point, the procedure goes to step S11. 
35 In step S11, judgment is made as to whether the 
surplus T b of the equation (2) is substantially equal 
to 0 or substantially equal to the natural vibration 
period X 2 . In either case, since the vibrations oc- 
curring respectively at the start and end time points 
40 of the slowdown period are inverted in phase with 
respect to each other, these vibrations interfere 
with each , other to suppress vibration. Since no 
correction is necessary to suppress a fresh vibra- 
tion, the procedure goes to step S13. In step S11, 
45 if it is not judged that the surplus T b is substantially 
equal to 0 or substantially equal . to the natural 
* vibration period X 2 , the procedure goes to step 
S12. In step S12, the rate a b of the second order 
curve portion is set in such a manner that the 
50 vibration causing time difference T 6 from the fall t 3 
to the rise U of the acceleration differential value v 
.(••) of the slowdown period is an integral number 
times the natural vibration period X 2 . This rate a b is 
expressed by the following equation where Ti is 
55 the duration of the acceleration period and T b is the 
surplus in the equation (1). 

a b Tb/Ti W 
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The duration of each of the acceleration constant 
increase period P B i and acceleration constant de- 
crease period Pb3 is defined as T b , and the speed 
pattern is calculated in such a manner that the 
second order curve portion of these periods and 
the straight portion of the constant acceleration 
period P B 2 are smoothly connected with each oth- 
er. Upon termination of . this calculating, the proce- 
dure goes to step S13. 

FIG. 7 and FIG. 8 show the speed instruction 
value v, the acceleration v Q and the primary 
differential value v (") of the acceleration if - the 
robot arm has a long stroke and is moved in such 
a manner that the durations of the acceleration and 
slowdown periods are equal to each other. The 
graph (d) of FIG. 7 and the graph (d) of FIG 8 
show the acceleration a of vibration of the robot 
arm end controlled by the speed instruction pat- 
tern. The graphs (a) - (d) of FIG. 7 show the speed 
instruction pattern before correction for suppress- 
ing vibration is made. The graphs (a) - (d) of FIG. 8 
show the speed pattern after correction. In FIG. 7, 
the duration of each of the acceleration and 
slowdown periods Ti , T 2 is one and a half times 
the respective natural vibration period \i , XV. At 
that time, the vibrations occurring at the rise and 
fall of the acceleration time differential value co- 
incide in' phase with each other. In this , case, the 
vibration remains in the succeeding period to exert 
influence on the work in that period. In order to 
prevent the vibration from remaining, correction for 
the above-mentioned speed instruction pattern is 
executed. Regarding the acceleration period, the 
value of the second order curve a a (= 33%) is 
calculated by substituting for the equation (3) the 
surplus T a (= 0.5 Xr) of calculation of the equation 
(1) and the acceleration period Ti (=1.5 Xi). 
Likewise, in the slowdown, period, a b = 33%. Thus 
the rates of a ,a b of the second order curves . are 
calculated, and the speed instruction pattern cal- 
culated based on the rates is shown in the graph 
(a) of FIG. 8. According to this speed instruction 
pattern, the vibration causing time differences Ts, 
T 6 coincide with the respective natural vibration 
periods Xi , X 2 . Therefore, as mentioned above, the 
vibrations occurring at the rise and fall time points 
mutually interfere to. cancel each other out. It is 
accordingly possible to reduce the remaining vibra- 
tion of the graph (d) of FIG. 7 largely as shown in 
the graph (d) of FIG. 8. 

In the foregoing description, the vibration caus- 
ing time differences Ts, T& after correction are 
equal to (onefold), the respective natural vibration 
periods Xi , x 2 . Alternatively, motion of the robot 
arm may be controlled in such a manner that the 
corrected vibration causing time difference T 5 , T 6 
is ah integral number (2 or more) times the natural 



vibration period Xi, X 2l thus obtaining a vibration 
suppressing effect. 

As mentioned above, without extending the ac- 
celeration and slowdown periods, it is possible to 

5 suppress the remaining vibration. Accordingly, it is 
possible to prevent the precision of robot drive 
control from lowering due to the remaining vibration 
so that the quality of products is prevented from 
being deteriorated. Further, partly since it is not 

10 necessary to wait to do the work until the remain- 
ing vibration has attenuated, and partly since it is 
unnecessary to extend the acceleration and 
slowdown periods in order to suppress vibration, 
the work time can be minimized. 

15 Since the control of this embodiment is not 

feedback control, it is not necessary to use a 
sensor for detecting a state of motion of the mov- 
ing part.. Further, since the control system does not 
have to be high-speed, it is possible to achieve 

20 vibration suppressing control at low cost. Still fur- 
ther, since a vibration suppressing effect can be 
achieved by optimizing the speed instruction, it is 
possible to cope with the existing apparatus without 
difficulties. 

25 In this embodiment, each time the speed in- 

struction value is corrected, the rate a of the sec- 
ond order curve is calculated, and a speed instruc- 
tion pattern linking the second order curve portions 
and the straight portions together smoothly is cal- 

30 . culated. Alternatively, the optimum pattern may be 
selected from a number of kinds of speed instruc- = 
tion patterns prepared in correspondence with the 
rate « of the second order curve. 

A second embodiment of this invention will 

35 now be described. In the foregoing embodiment, if 
the duration of each of the acceleration -and 
slowdown periods Ti , T 2 is shorter than the re- 
. spective natural vibration period Xi , X 2 , it is impos- 
sible for the vibration causing time difference to 

40 coincide with the natural vibration period. If the 
acceleration period and the slowdown period are 
close to each other, it is possible to suppress the 
vibration, which occurs in the acceleration period, 
by the vibration causing force in the slowdown 

45 period. In the second embodiment, vibration sup- 
pressing control taking due consideration of this 
case is carried out. 

FIG. 9 is a flowchart of vibration suppressing 
control of this embodiment. First of all, in 'step S20, 

50 the vibration of the distal end of the robot arm 4 is 
measured. In step S21, the measured vibration is 
frequency-analyzed, arid a judgment is made as to 
whether the frequency of the vibration . includes a 
single frequency or a plurality of frequencies. In the 

55 case of a single frequency, this frequency is re- 
garded as the natural vibration frequency, of the 
system. In the case of plural frequencies, the low- 
est frequency is. regarded as the natural vibration 
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frequency of the system in step S22 In step S23, 
the natural vibration period is calculated as the 
reciprocal number of the natural vibration frequen- 
cy. 

The calculation of. this natural vibration period ■ 
is conducted at two points , i.e. the start and end 
points, if controlling takes place on a single motion. 
Namely, the natural vibration period Xi at the mo- 
tion start point and the natural vibration period X 2 at 
the motion end point are . calculated. If controlling 
takes place on many motions, in a controlling 
method, a vibration is measured at the start and 
end points of each motion, and the results of 
measurement are stored, in another controlling 
method, vibration is measured at a typical point 
and with respect to a typical load to formulate an 
estimation equation, and the natural vibration is 
obtained based on the estimation, equation in the 
actual controlling. In the former method, vibration 
measurement is conducted for every motion in the 
actual work to obtain the natural vibration period, 
and when calculating the speed instruction value, 
data relating to the motion is recalled and the 
speed instruction pattern is corrected, if necessary. 
In the latter method, vibration measurement is con- 
ducted at a typical point and with respect to a 
typical load to formulate an estimation equation, 
and the natural vibration period is calculated from 
the actual motion, based on this estimation equa- 
tion. According to the latter method, it is not neces- 
sary to conduct vibration measurement for a new 
motion. If the motions are limited to a small num- 
ber, however, it is desirable to actually measure 
vibration similarly-to the former method. 

Then in step S24, moving speed patterns are 
calculated as. the speed instruction values. These 
patterns are chiefly divided into two groups, one 
shown in the graph (a) of FIG. 10 and the other 
shown in the graph (a) of FIG. 11. The pattern of 
the graph :(a) of FIG. 10 is devoid, of a constant 
speed period and has a short moving distance, and 
in this pattern the speed is slowed down before 
reaching the maximum. The graphs (b) and (c) of 
FIG. 10 show the acceleration and vibration of the. 
robot arm end when the motion is performed ac- 
cording to the speed instruction of the graph (a) of 
FIG/10. In several diagrams, T P stands for the time 
difference of acceleration peaks with the torque at 
peak. In step S25, the. time difference T P of accel- 
eration peaks and the . duration Ti', T 2 of each of 
the acceleration and slowdown periods are cal- 
culated. 

In step S26, a judgment is made as to whether 
or . not the acceleration peak time difference T P is 
larger than the natural vibration period \i at the 
motion start, point, thereby discriminating whether 
the speed pattern is classified as the group of the 
graph (a) of FIG. 10 or the graph (a) of. FIG. 11. If 



the acceleration peak time difference T P is. judged 
not larger than the natural vibration period Xi, it is 
possible that the vibrations occurring in the accel- 
eration and slowdown periods interfere to pancel 
5 each other, as the acceleration and slowdown 
periods are close to each other. This condition is 
that the time difference of torque peaks occurring 
in each of the acceleration and slowdown periods 
coincides with the natural vibration period. The 
w torque peak and the acceleration peak substantially 
coincide with each other, and therefore in step S36, 
the speed instruction pattern is corrected in such a 
manner that the acceleration peak time difference 
T P coincides with the natural vibration period Xi. 
75 FIG. 12 shows an example of control in which 

the speed instruction pattern is corrected. The 
' . speed instruction indicated by a dotted line in the 
: graph (a) of FIG. 12 is such that the time difference 
T P of torque peaks in the acceleration and 
20 slowdown periods is equal to a half of the natural 
vibration period Xi (i.e. T P = Xi/2). In this case, the 
acceleration shown in the graph (b) of FIG. 12 
varies so that the vibrations occurring in the accel- 
eration and slowdown periods are uniform in phase, 
25 thus amplifying vibration. Then, as indicated by a 
solid line in the graph (a) of FIG. 12, the torque 
peak time difference T P such as to coincide with 
the natural vibration period, is set by extending the 
time duration between acceleration and slowdown, 
30 thereby suppressing vibration as shown in the 
graph (c) of FIG. 12. Then, the motion according to 
the pattern corrected in step S37 is made. In such 
a case, because the natural vibration period does 
not substantially vary at the motion start and end 
35 points as the moving distance is small, only the 
natural vibration period at the start point is taken 
into consideration. 

. If the acceleration peak time difference T P is 
judged to be larger than the natural vibration period 
40 Xi .', the speed instruction pattern at that time is 
shown in the graph (a) of FIG. 11. In step S27, the 
duration Ti, T 2 of each of the acceleration and 
slowdown periods is judged to be larger than the 
respective natural vibration period X v , X 2 . If the . 
45 period duration T^, T 2 is. judged to be not larger 
than the respective natural vibration period Xi , X 2 , it 
js impossible for the vibration causing time dif- 
ference to come into coincidence with the natural 
, vibration period in the corresponding period as 
50 described in the previous embodiment. Namely, in 
the previous embodiment, the vibration causing 
time difference is reduced to coincide with the 
natural vibration period by providing acceleration 
constant increase and decrease periods represent- 
55 ed by second order curves. In the case of the 
above-mentioned , condition, because the duration 
of each of the acceleration and slowdown periods 
is shorter than the natural vibration period, the 
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vibration. causing. time difference cannot be brought 
into coincidence with the natural vibration period by 
reducing the vibration causing time difference fur- 
ther. Consequently, in step S34, the vibration caus- 
ing time differences Ti, T 2 are brought into co- 
incidence with the respective natural vibration 
periods Xi ; X2 by extending the acceleration period 
and the slowdown period. The speed instruction 
pattern at that time does not include the accelera- 
tion constant increase and decrease periods repre- 
sented by second order curves in the acceleration 
and slowdown periods, namely, assuming a 
trapezoidal shape like the conventional art. It is 
thereby possible to achieve a vibration suppressing 
control as the vibrations occurring at the start and 
. end points in each of the acceleration and 
slowdown periods interfere with each other. 

FIG. 13 shows another example of control in 
which the speed instruction pattern is corrected. 
The speed instruction pattern, before correction, 
indicated by a dotted line in the graph (a) of FIG. 
13 is equal to a half of the respective natural 
vibration period Xi , X 2 in each of the acceleration 
and slowdown periods T1 , T2. In this example, the 
duration from the acceleration period to the 
slowdown period is adequately long. In this case, 
as indicated by the dotted line in the graph (b) of 
FIG. 13, the vibrations occurring in the start and 
end points in the acceleration period are amplified 
by each other, and this is also the case with the 
slowdown period. As mentioned above, in such a 
case, correction is made in such a manner that the 
duration, of each period Ti , t 2 coincides with the 
respective natural vibration period Xi, X 2 . The thus 
corrected speed instruction pattern is shown by a 
solid line of the graph (a), in which the acceleration 
and slowdown periods are extended in such a 
manner that TV (= X0, T' 2 (= X 2 ). At that time, as 
indicated by . a solid line, of the . graph (b), the 
vibrations occurring at the start and end points in 
each period are canceled by each other to sup- 
press vibration. 

In step S27, if each vibration causing time 
difference Ti., T 2 is judged to be larger than the 
respective natural vibration period Xi, X 2 , it is pos- 
sible to make each vibration causing . time differ- 
ence Ti, T 2 coincide with the. respective natural 
vibration period Xi, X 2 by reducing Ti , T2, similarly 
to the previous embodiment. In step S28, the sur-. 
pluses are calculated as the equations (1), (2) of 
the previous embodiment.. In step S29, it is judged . 
as to whether or not the surplus T a relating^o the 
acceleration period is substantially equal to 0 or Xi . 
If it is equal, since the vibrations occurring at the 
start and end points in the acceleration period 
interfere with each other to give a vibration sup- 
pressing effect, the speed instruction pattern is 
used without correction, whereupon procedure 



goes to step S30. On the contrary, if the surplus T a 
is judged to be not equal to 0 or Xi, in step S32, 
the rate a a of the second order curve is determined 
in such a manner that the vibration causing time 
5 difference T 5 coincides with the natural vibration 
period Xi. Preferably, the vibration causing time 
difference T s coincides with the natural vibration 
period Xi itself and does not coincide with a 2 or 
greater integral number times the natural vibration 

10 period Xt . Since the next vibration causing force is 
given before the vibration occurring due to the. first 
vibration causing force attenuates, it is possible to 
cancel the vibration effectively. 

After a speed instruction pattern of the accel- 

15 eration period is determined, a speed instruction 
pattern in the slowdown period is estimated ih step 
S30 arid following steps. In step S30, the surplus 
T b in the equation (2) is judged to be substantially 
equal to 0 or X 2 . If it is equal, because the vibra- 

20 tions occurring at the start and end points in the 
slowdown period interfere with each other to. 
achieve a vibration suppressing effect, the speed 
instruction pattern is used without correction, 
whereupon the procedure goes to step S31 . On the 

25 contrary, ;if the surplus T b is judged to be substan- 
tially equal to .0 or X 2 , in step S33, the rate a b of 
the second order curve is determined in such a 
manner that the vibration causing time difference 
T 6 coincides with the natural vibration period X 2 ; 

30 Also in this case, the vibration causing time dif- 
ference T & coincides with the natural vibration per 
riod X 2 itself and does not coincide with a 2 or 
greater integral number times the natural vibration 
period X 2 . Since the next vibration causing force is 

35 given before the vibration occurring due to the first 
vibration causing force attenuates, it is possible to 
cancel the vibration effectively. In step S31,. the 
robot arm is driven according to this corrected 
speed instruction pattern. 

40 FIG. 14 is a block diagram showing a CPU 11 

of the « apparatus according to this embodiment. 
The CPU 1 1 calculates a speed instruction pattern, 
as an example of drive pattern, in a drive pattern 
calculating section 211. The torque peak time dif- 

45 ference of the acceleration and slowdown periods 
in the calculated speed instruction pattern is cal- 
culated by a torque peak time difference calculat- 
ing section 212. - 

The resulting torque peak time difference is 

50 then compared with. the natural, vibration period of 
the system in a first comparing and judging section 
213. If the torque peak time difference is judged to 
be larger than the natural vibration period as the 
result of comparison, the differential value of the 

55 acceleration with respect to time is calculated ih an 
acceleration differential value calculating section ' 
214 from the above-mentioned speed instruction 
. pattern. The time difference of rise and fall portions 
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of the differential value of each of the acceleration 
and slowdown periods is calculated in a time dif- 
ference calculating section 215. ; 

Then, comparison of this tjme difference with 
the natural vibration period takes place in a second 
comparing and judging section 216. However, in 
this embodiment, if the rise and fair portions of the 
differential value in each period substantially co- 
incide with each other at the start and end time 
points of the period, comparison of the acceleration 
and slowdown periods with the respective natural 
vibration period takes place in the second compar- 
jng and judging section 216. If each of the accel- 
eration and slowdown periods is larger than the 
respective natural vibration period, the drive pattern 
is corrected in a first drive pattern correcting sec- 
tion 217. The first drive pattern correcting section 
217. is identical in construction and result to the 
drive pattern correcting section 114 of FIG. 5, so its 
description is omitted here. 

On the other hand, if in the second comparing 
and judging section 216, the period duration is 
judged to be shorter . than the natural vibration 
period, the drive pattern is corrected in a second 
dirve pattern correcting, section. This correction is 
such that the duration of the corresponding period 
coincides with the natural vibration period. 

Further, if in the first comparing and judging 
section 213 the torque peak time difference is 
judged to be shorter, than the natural vibration 
period, the drive pattern is corrected in a third drive 
pattern correcting section 219. This correction is 
such that the time difference of torque peaks in the 
acceleration and slowdown periods coincides with 
the natural vibration period pf the system. 

According to this embodiment, it is possible to 
perform reliable vibration suppression in various 
motion patterns. For example, in either of the pat- 
terns shown in the graph (a) of FIG. iO and the 
graph (a) of FIG. 11, it is possible to perform 
individual controls in compliance with the respec- 
tive characteristics so that vibration can be sup- 
pressed reliably. Further, if each of the acceleration 
and slowdown periods is short, the period is ex- 
tended to coincide with the natural vibration period, 
thereby suppressing vibration. Furthermore, by 
having the vibration causing time difference of each 
of acceleration and slowdown periods in coinci- 
dence with the natural vibration period and by 
giving: the next vibration causing force before the 
vibration occurring due to the first vibration causing 
force attenuates, it is possible to suppress vibration 
reliably. 

In each of the foregoing embodiments, the 
vibration of the robot hand is detected by detecting 
the vibratio.nof the distal encl of the robot hand by, 
for example, an acceleration sensor. Alternatively 
the vibration may be detected in terms of an 



; amount of electric current supplied to a servo mo- 
tor. If vibration occurs in the distal end of the robot 
arm, a force similar to the vibration waveform of a 
drive force acts on the servo motor to give the 
5 drive forc6 in the direction of vibration. At that time; 
an electric current is supplied to the servo motor in 
such a manner that the servo motor generates a 
force against the applied force so as to hold the 
motor position. Accordingly, at that time! the vibra- 
70 tipn waveform and the electric current waveform 
supplied to the servo motor substantially match 
with each other as shown in FIG. 15. Because their 
periods T^ T v in particular coincide with each 
other, measuring only the electric current waveform 
75 suffices in measuring the natural vibration period. 

FIG. 16 shows an apparatus for detecting an 
electric current to be supplied , to a servo motor to 
calculate the natural vibration frequency: A servo 
amplifier 2 for controlling the servo motor 3 based 
20 on the speed instruction includes a speed control- 
ler 21 and an electric current controller 22. The 
electric current controller 22 controls an electric 
current to be supplied to the servo motor 3, and 
from the electric current controller 22 the waveform 
25 of a control electric current can be detected. The 
. electric current waveform is introduced into a fre- 
quency analyzer 6 such as a fast Fourier trans- 
former (FFT). The highest power spectral peak is 
then detected as the natural vibration frequency of 
30 the system. Alternatively the controller itself may 
have a frequency analyzing function. 

In measuring the natural vibration period, by 
detecting an electric current waveform to be sup- 
plied to the servo motor for driving the system and 
35 regarding the fundamental frequency of the electric 
current waveform as the natural vibration frequency 
of the system, it is possible to detect the natural 
vibration period without the trouble of, for example, 
attaching an acceleration sensor. 
40 Vibration occurring at an arm part of an indus- 

trial robot when the arm part is moved is controlled 
by combining vibrations occurring at two time 
points for mutual, interference, In each of accelera- 
tion and slowdown periods, the time difference of 
45 rise and fall time points ti, U and fc, t3 of a 
differential value of an acceleration with respect to 
time is set to be an integral, number times the 
natural vibration period of the system so that the 
vibrations occurring, at the rise and fall time points 
50 interfere with each other to cancel one another 
Also, the vibration occurring in the acceleration 
period and the vibration occurring in the slowdown 
period can cancel each other. 

55 Claims 

1. A method of computing a drive pattern for 
suppressing vibration of a moving part, com- 
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prising the steps of: 

(a) obtaining a driving pattern of the moving 
part, which pattern includes an acceleration 
period, a constant speed period and a 
slowdown period; 5 

(b) calculating a differential value of accel- 
eration with respect, to time of the moving 
part, from said drive pattern; 

(c) calculating a time difference between a 

rise portion and a fall portion of said dif- . 70 
ferential value of the acceleration time; and 

(d) correcting said drive pattern in such a 
manner that said time difference changes 
substantially by an integral number times a * 
natural vibration period of the moving part. 15 

2. A drive pattern computing method according to 
claim 1, wherein said drive pattern correcting 
step comprises fixing the duration of at least 

the acceleration and slowdown period, setting 20 
in said fixed duration of the acceleration or 
slowdown period, an acceleration constant in- 
crease period in which acceleration increases 
at a constant rate with respect to time, and an 
acceleration constant decrease period in which 25 
acceleration decreases at a constant rate with' 
respect to time, and correcting the duration of 
each of said acceleration constant increase 
period and acceleration constant decrease pe- 
riod. 30 

3. A drive pattern computing method according to 
claim 2, wherein said, drive pattern correcting 
step is the step of selecting said drive pattern 
from a number , of previously prepared drive 35 
patterns. 

4. A drive pattern computing method according to 
claim i, wherein said natural vibration period of 

the moving part is calculated by driving the 4o 
moving part in a predetermined pattern by an 
electric motor, detecting a variation of a driving . 6. 

current of the electric motor, which variation is 
caused due to the vibration of the moving part 
.in response to said driving, and measuring 45. 
said natural vibration period of said moving 
part from the detected electric current 
waveform. 

5. A method of computing a drive pattern for 50 
suppressing vibration of a moving part, com- 
prising the steps of: 

(a) obtaining a driving pattern of the moving 
part, which pattern includes an acceleration 
period, a constant speed period and a 55 
slowdown period; and 

(b) judging, by comparing the duration of 
each of said acceleration period and 



slowdown period of said drive pattern with 
said natural vibration period of the moving 
part, whether the duration of each of said 
acceleration period and slowdown period of 
the drive pattern is- longer or shorter than 
said natural vibration period; 
,(c) said method, if said acceleration or 
slowdown period is longer than said natural 
vibration period, further including: (1) cal- 
culating a differential value of acceleration 
with respect to time of the moving part from 
said drive pattern; (2)' calculating a time 
difference between a rise portion and a fall 
portion of said differential value of accelera- 
tion with respect to time; and (3) correcting 
said drive pattern, in such a manner that 
said time difference, increases substantially 
by an integral number times a natural vibra- 
tion period 'of the moving part, by fixing the 
duration of at least the acceleration and 
slowdown period, setting in said fixed dura- 
tion of the acceleration or slowdown period 
an acceleration constant increase period in 
which acceleration increases at a constant 
rate with respect to time and an accelera- 
tion constant decrease period in which ac- 
celeration decreases at a constant rate with 
respect to time, and correcting the duration 
of each of said acceleration constant in- 
crease period and acceleration constant de- 
crease period; 

(d) said method, if said acceleration or 
slowdown period is shorter than said natural 
vibration period, further including the step of 
(4) correcting the duration of said accelera- 
tion or slowdown period, so as to be equal 
.. to said natural vibration period of the mov- 
ing part, under the condition that accelera- 
tion is constant in said acceleration or 
slowdown period. . 

A method of computing a drive pattern for 
suppressing vibration of a moving part of an 
industrial robot, comprising: 

(a) obtaining a drive pattern of the moving 
part; 

(b) calculating a time difference of torque 
peaks in said acceleration and slowdown 
periods of said drive pattern; and 

(c) judging, by comparing said time dif- 
ference with said natural vibration period of 
the -moving part, whether said time differ- 
ence is longer or shorter than said natural 
vibration period; 

(dj said method, if said time difference, is 
shorter than said natural vibration period, 
further including: (1 ) correcting said drive 
pattern in such a manner that said time 
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difference of said torque peaks substantially 
coincides, with said natural vi oration period;. 

(e) said method, if said time difference is 
longer than said natural vibration period, 
further including the steps of: (2) calculating 
a time duration of each of acceleration and 
slowdown periods of said drive pattern; and 
(3) judging, by comparing the duration of 
each of said acceleration and slowdown 
periods of said drive pattern with said natu- 
ral vibration period, whether the duration of 
said acceleration and slowdown periods is 
longer or shorter than said natural vibration 
period; 

(f) said method, if the duration of said accel- 
eration or slowdown period is ; longer than 
said natural vibration period, further includ- 
ing the steps of: (4) calculating a differential 
value of acceleration with respect to time of 
the moving part from said drive pattern; (5) 
calculating a time difference of rise and fall 
portions of said acceleration time differential 
value; and (6) correcting said drive pattern,, 
in such manner that said time difference 
changes by an integral number times said 
natural vibration period, by fixing the dura- 
tion of said acceleration or slowdown period 
and setting an acceleration constant in- 

. crease period in which acceleration in- 
creases with time at y a constant rate in the 
last-named period and an acceleration con- 
stant decrease time in which acceleration 
decreases with time at a constant rate; 
(g) said method, if said acceleration or 
slowdown period is shorter than said natural 
vibration period, further including the step of 
(7) correcting said drive pattern, in such 
manner that the duration of said accelera- 
tion or slowdown period coincides with said 
natural vibration period, under the condition 
that acceleration is constant in said accel- 
eration or slowdown period. 

A method of controlling a moving part of an 
industrial robot, wherein said' moving part is 
driven and controlled in a predetermined drive 
pattern in which a time difference of rise and 
fall portions of a differential value of accelera- 
tion with respect to time of said moving part is 
substantially an integral number times a natural 
vibration period of said moving part. 

A controlling method according to claim 10, 
wherein said drive pattern includes, an accel- 
eration period in which said moving part is to 
be accelerated and a slowdown period in 
which said moving part is to be slowed down, 
and said acceleration and . slowdown periods 



include an acceleration constant increase pe- 
riod, in which acceleration increases with time 
at a constant rate, and an acceleration constant 
decrease period in which acceleration de- 
5 creases with time at a constant rate. 

9. An apparatus for computing a drive pattern, for 
suppressing vibration of a moving part of an 
industrial robot, comprising: 
70 (a) means for obtaining a drive pattern of 

said moving pattern which pattern includes 
an acceleration period, a constant speed 
period and a slowdown period; 

(b) means for calculating, a differential value 
75 of acceleration with respect to time of said 

moving part from said drive pattern; 

(c) means for calculating a time difference 
of rise and fall portions of said acceleration 
time differential value; and 

20 (d) means -for correcting said drive pattern 

in such a manner that said time difference • 
is substantially an integral number times a 
natural vibration period of the moving part. 

25 10. A drive pattern computing apparatus according 
to claim 13, wherein said drive pattern correct- 
ing means comprises means for fixing the du- 
ration of at least acceleration and slowdown 
period, means for setting in said fixed duration 

30 of the acceleration or slowdown period an ac- 

celeration constant increase period in which 
acceleration increases at a constant rate with 
respect to time, and an acceleration constant 
decrease period in which acceleration de- 

35 creases at a constant rate with respect to time, 

and means for. correcting the duration of each 
of said acceleration constant increase period 
and acceleration constant decrease period. 



40 11. An apparatus for computing a drive pattern for 
suppressing vibration of a moving part, com- 
prising: 

(a) means for obtaining a driving pattern of 
the moving part, which pattern includes ah 

45 acceleration period, a constant speed period 

and a slowdown period; and 

(b) means for judging, by comparing the 
duration of each, of said acceleration period 
and slowdown period of said drive pattern 

50 with said natural vibration period of . the 

moving part, whether the duration of each of 
said acceleration period and slowdown pe- 
riod of the drive pattern is longer or shorter 
than said natural vibration period; 

55 . (c) said apparatus, if said acceleration or 

slowdown period is . longer than said natural 
vibration period, further including: (1) means 
for calculating a differential value of accel- 
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eration with respect to time of the moving 
part from said drive pattern; (2) means for 
calculating a time difference between a rise 
portion and a fail portion of said differential . 
value of acceleration with respect to time; 5 
and (3) means for correcting, said drive pat- 
tern, in such a manner that said time dif- 
ference changes substantially by an integral 
number times a natural vibration period of 
the moving part, by fixing the duration of at w 
least acceleration and slowdown period, set- 
ting in said fixed duration of the acceleration 
or slowdown period, an acceleration constant 
increase period, in which acceleration in- 
creases at a constant rate with respect to 75 
time, and an acceleration constant decrease 
[ period, in which. acceleration decreases at a 
constant rate with respect to time, and cor- 
recting the duration of each of said accel- 
eration constant increase period and accel- 20 
eration constant decrease period; 
(d) said apparatus, if said acceleration or 
slowdown period is shorter than said natural 
vibration period, further including (4) means 
for. correcting the duration of said accelera- 25 
tion or slowdown period, so as to be equal 
to. said natural vibration period of the mov- 
ing part, under the condition that accelera- 
tion is constant in said acceleration or 
slowdown period. 30 

12. An apparatus for computing a drive pattern for 
suppressing vibration of a moving part of an 
industrial robot, comprising: 

(a) means for obtaining a drive pattern of 35 
the moving part; . 

(b) means for calculating a time difference 
of, torque peaks in acceleration and. 
slowdown periods of said drive pattern; and 

(c) means for judging, by comparing said . 40 
time difference with said natural vibration 
period of the moving part, whether said time 

: difference is longer or shorter than said 
natural vibration period; 

(d) said apparatus, if said time difference is 45 
shorter than said natural vibration period, 
further including: (1) means for correcting 

said drive pattern in such a manner that 
said time difference, of said torque peaks 
substantially coincides with said natural vi- 50 
bration period; 

(e) said apparatus, if said time difference is 
longer than said natural vibration period, 
further including:. (2) means for calculating a 
time duration of each of said acceleration 55 
and slowdown periods of said drive, pattern; 

and (3) means for judging, by comparing 
the duration of each of said acceleration * 



and slowdown periods of said drive pattern 
with said natural vibration period, whether 
the duration : of said acceleration and 
slowdown periods is longer or Shorter than 
said natural vibration period; 
(f) said apparatus, if the duration of said 
acceleration or slowdown period is longer 
than said natural vibration period, further 
including: (4) means for calculating a dif- 
ferential value of acceleration with respect 
to time of the moving part from said drive 
pattern; (5) means for calculating a time 
difference of rise and fall portions of said 
acceleration time differential value; and (6) 
means for correcting said drive pattern, in 
such a manner that said time difference 
changes by an integral number times said 
natural vibration period, by fixing the dura- 
tion of said acceleration or slowdown period 
and setting an acceleration constant in^ 
crease period, in which acceleration in- 
creases with time at a constant rate, and an 
acceleration constant decrease time in 
which acceleration decreases with time at a. 
constant rate; 

.(g) said apparatus, if said acceleration or - 
slowdown period is shorter than said natural 
vibration period, further including (7) means 
for correcting said drive pattern, in such, 
manner that the duration of said accelera- 
tion or. slowdown period coincides with said 
natural vibration period, under the condition 
that acceleration is constant in said accel- 
eration or slowdown period. 
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